#ifndef  __MOTOR_H_
#define __MOTOR_H_

#include "config.h"

#define MOTORS 				P2
#define BEATS_COUNT 	8

#define L4		0x08
#define L3		0x04
#define L2		0x02
#define L1		0x01


// 步距角度 5.625°/ 64
//    x = 5.625°/ 64
//8 * x = 5.625°* 8 / 64 （函数执行一次，末端旋转的角度）
#define CIRCLE (5.625 / 8)

// absolute 绝对值
#define ABS(x) (((x) < 0) ? -(x) : (x))

// 初始化
void motor_init();
// 顺时针旋转
void Motor_CW();
// 逆时针旋转
void Motor_CCW();
// 停车
void Motor_Stop();
// 旋转角度
void Motor_turn(float angle);
#endif